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Abstract 

[n  this  paper  ]  describe  a  solution  to  the  reverse  GPS  problem  and  its  application 
to  positional  goal  staking  for  a  swarm  of  autonomous  drones.  GPS  uses  known 
positions  and  corresponding  ranges  from  multiple  beacons  to  a  single  location 
to  determine  the  coordinates  of  that  location.  In  contrast,  this  work  uses  range 
measurements  from  a  single  target  or  beacon  (of  unknown  position)  to  a  group 
of  cross-communicating  autonomous  objects.  These  autonomous  objects,  using 
estimates  of  tlieir  own  relative  (not  absolute)  locations,  estimated  ranges  to  one 
another,  and  range  data  to  the  goal  will  converge  on  that  goal.  The  convergence 
algorithm  is  based  on  a  linear  least-squares  approach  thus  creating  minimal 
demands  for  on-board  computational  resources.  An  example  application  Is  used 
to  demonstrate  the  robustness  of  the  approach  by  using  a  simple  range  finder 
based  on  assumed  transmitter  power  and  a  simple  attenuation  model.  The 
results  show  the  algorithm  and  convergence  are  not  sensitive  to  errors  in  the 
assumed  attenuation. 

Keywords;  Autonomous  drones,  inverse  trilateration,  least  squares 
optimization,  quadmtor 
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1 .  Inverse  Trilateration 

The  Global  Positioning  System  (GPS)  uses  a  geometric  process  called  tri  it¬ 
eration  to  determine  the  position  of  a  receiver.  Most  simply  stated,  trilateration 
is  a  proctrss  of  determining  a  position  by  considering  the  intersection  of  multiple 
i  spheres.  The  minimum  number  of  spheres  required  to  determine  a  three  dimen¬ 
sional  position  is  four.  The  Int  ersection  of  two  spheres  (assuming  they  intersect) 
will  create  a  circle;  the  thin]  is  requited  to  reduce  the  set  of  p<&slble  points  to 
two;  and  the  fourth  reduces  the  set  to  a  unique  point. 

The  GPS  uses  a  sopMsticafcd  constellation  of  satellites  that  transmit  posh 
:u  tit.ui  and  timing  data  continuously.  Each  satellite  carries  an  atomic  clock  and 
regularly  updated  ephemeris  data.  The  GPS  has  proven  Itself  immensely  bene¬ 
ficial  in  innumerable  civilian  and  military  applications.  In  ideal  circumstances, 
positions  for  all  objects  at  all  times  can  be  determined  and  known  with  high 
accuracy  through  GPS.  In  ideal  circumstances,  the  work  described  in  this  papEir 
n  would  be  unnecessary, 

hi  many  situations  GPS  is  unavailable  nr  unreliable.  This  condition  can 
be  caused  by  geographical  obstacles  such  as  those  encountered  lit  mountain¬ 
ous  terrain.  Tile  condition  may  also  occur  through  man-made  effects,  such  as 
intentionally- induced  GPS  denied  environments,  Jn  these  situations,  alternative 
™  methods  must  be  invoked  -ones  dial  do  not  rcEy  upon  absolute  position. 

Tins  problem  described  In  this  papier  is  different  from  other  work  on  nav¬ 
igating  in  a  GPS-denied  envLronmeigt  such  us  Simultaneous  Localization  anti 
Mapping  or  SLAM.  SLAM  is  the  process  of  sensing  an  unknown  environment 
using  available  sensor  flat  a  to  develop  both  the  pose  of  the  drone  and  a  map 

*  of  the  environment  [lj.  Tins  work  is  concerned  only  with  goal  seeking;  finding 
tin;  simplest  way  for  a  swarm  of  autonomous  drones  to  converge  upon  an  object 
with  no  requirement  for  absolute  position, 

LI.  The  Reveme  CPS  Pntblcm 

Tire  reverse  GPS  problem  considers  a  single  beacon  transmitting  a  signal 

*  from  which  a  range  (but  not  position)  can  bo  dot  ei  mined-  These  range  inta- 
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Drone  1, yi) 


Figure  Geometry  for  a  group  of  four  drones  and  a  single  (goal)  beacon. 


suremeuta  can  then  be  used  by  a  group  of  autonomous  entities  wlio  sliare  data 
about  their  own  estimated  position  relative  to  one  anotlicr  and  their  estimated 
range  to  the  beacon.  Figure  1  illustrates  the  geometry  of  the  problem,  with  the 
real  world  3D  problem  reduced  to  2D  for  simplicity. 

The  objective  for  each  drones  is  to  determine  a  velocity  vector  which  will  move 
it  from  its  present  location  towards  the  goal.  The  necessary  velocity  vector  for 
each  drone  is  determined  through  tlie  following: 

1.  its  own  estimated  position, 

2.  its  own  estimated  range  to  the  goal  beacon,  i\ 

3.  tlic  estimated  positions  of  all  of  Iter  drones  in  the  swamp  {ij, 

d,  the  estimated  range  of  each  drone  to  the  goal  beacon,  Tj 

Based  on  figure  1  the  distance  between  drone  i  and  drone  j  is  given  by 


The  distance  between  drone  i  and  the  goal  is  given  by 


(2) 


Talcing  the  above  equation  and  mixing  in  the  influence  of  the  other  drones  (by 
adding  ami  subtracting  x^  and  yj)  gives 


if  =  (#*  “  *if  +  (fftf  ~  Vif 

=  {Sx  ~  +'%  -  *i?  +  (9S  -Vj+tij-  Vi)* 

=  (fc  -  Xjf  +  2(jr  -  -  £<)  +  (iTj  -  Xif 

+  (tto  -  v-i?  +  2  to h  ~  jg  Hi h  -  Vi)  +  {vs  -  Vi? 

Rearranging  terms  gives 


“al(ftp  “  ”  Vj)(Vi  "  i/j))  = 

ri  ~  -  *i?  +  to*  -  Vj?]  ~  \{xj  -  Xif  +  (yj  -  y,)3J 

or 


(4) 


(9x  ~  -  xj)  +  {3ii  -  Vi){yi  -  ifj)  =  i{rf  +  rlj  -  if)  (5) 

If  we  now  choose  any  one  of  the  n  drams,  can  develop  a  system  of 
equations  for  that  particular  drone-tlie  one  which  will  be  attempting  to  find  a 
»  solution.  As  such,  equation  5  represents  a  set  of  n  -  1  lintsar  equations  for  drone 
f.  For  t lit;-  case  of  drone  1,  equation  5  becomes 

(®r  -  a:i)(*a  -  *i)  +  totf  -  WiKtra  -yi)  -  +  r\A  -  rj) 

to^  -  *i  )(*s  -  Bi )  +  too  -  yi  )(ya  -  V t )  -  ^(rjf  +  r(  a  “  rf) 

(0> 

(9t  -  *i )(*«  *-  ari)  +  (f Jy  -  V\)(Vn  -1/1 )  ^  i(rf  +  rj  „  -  rl) 


Optimization  tudiniqties  for  improving  GPS  accuracy  have  been  studied 
*  through  least  squares  and  non  linear  least  squares  approaches  using  the  same 
formulation  given  above  [2]  However,  the  goal  in  the  previous  work  was  to  find 
an  absolute  3D  position,  Le.  y*  and  9„  (and  yf).  Tlie  goal  in  this  work  is  to 
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fintt  the  difference  I in  positions  between  the  unknown  beacon  and  each  individ¬ 
ual  drone,  f.c.  (j,  -  jsj.)  and  (yv  -  ^).  from  which  drone  commands  can  be 
generated. 


J.£.  Least  Square.*  Solution 

The  act  of  equations  developed  in  the  previous  section  represent  an  flverdo- 
term  tried,  linear  system  of  equations.  Because  the  distances  r,  and  ?Vj  and 
aEl  positions  are  only  approximate  the  problem  lends  itself  to  a  least  squares 
solution.  Fur  this  problem,  I  will  express  the  set  of  equations  with  the  form 
A  X  -  b  ^  0  where 


A  = 

*3  -  1  V'i  -  Vi 

x=fa‘-:c')  b  = 

'U’l  +  'li-r’S 
iH+r?i2-r|) 

V'n  “  yn  “  V\j 

UM  + 

The  least  squares  approach  requires  us  to  minimize  the  sum  of  rise  squares  of 
the  residuals,  i.o 

VF(X)=0  (8) 

where  ffX)  —  |f  AX  —  b|P  =  (AX  —  bj^(AX  —  b).  This  leads  to  a  solution  in 
tlie  form  of 

X=(ATAr‘ATb  (9) 

2.  Simulations  of  an  n-tirone  system  using  least  squares  optimization 

Each  drone  was  modeled  as  a  single  entity,  with  the  ability  to  transmit  to 
other  drones  its  own  estimated  position  and  its  measured  range  to  tire  beacon. 
Each  drone  uses  these  values  to  find  a  solution  from  equation  3.  Thu  solution  is 
converted  to  a  velocity  (or  command)  by  normalizing  the  difference  vector  X, 
Le'  v  =  X/||X||  and  assuming  a  time  step  of  At  =  1  Each  drone  object  then 
advances  using  a  simple  proportional  controller, 


n  drones 

x  =  {$r  ~  iSv ih)  M 

V*  (til) 

(m) 

||ir|j 

6 

(K02,  002) 

ft  10.8 

331.2 

008.7 

10 

(0G0,  095) 

248.4 

171.0 

302.1 

IE 

(087,  387) 

145.0 

147.8 

210.(5 

20 

(984,  m) 

131.7 

100,7 

169.5 

Table  1:  Least  squares  solution  for  drouu  1  as  a  function  of  nr  the  number  of 
drones  in  the  swarm.  The  beacon  is  located  at  a  posit  ion  ( 1000,10(11}  m  and 
drone  one  is  at  (0,0).  The  uncertainty,  a  is  the  standard  deviation  after  20,(1(10 
calculations.  The  uncertainty  in  all  position  and  range  m inurements  is  1.0  m. 

hi  all  conceivable  scenarios,  uncertainty  will  be  present  in  every  range  and 
position  measurement..  Therefore,  the  accuracy  of  the  solutions  given  in  equa¬ 
tion  0  and  tiie  uncertainty  should  be  affected  by  tin  number  of  drones,  n. 
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Figure  2:  Starting  positions  for  !5,  it),  15,  and  20  drone  swarms. 


This  result  is  shown  In  table  1,  by  assuming  an  uncertainty  of  1,0  m  and  a 
goal  beacon  placed  at  a  location  of  (l(MH),  1000)  in.  The  swarm  is  distributed 


iii  a  uniform,  recta ngn tar  pattern,  with  the  ^positions  ami  r^posit tons  spaced 
rt  f)  m  Drono  one  is  always  placed  at.  (0,0)  and  all  drones  start  with  posi¬ 

tive  coordinates.  The  starling  configurations  fur  each  simulation  are  shown  in 
figure  2.  The  data  in  the  table  represent  the  results  after  20,(K)Q  simulations. 

The  asymmetry  in  the  x  and  y  standard  deviation  represents  the  asymmetry 
in  the  Initial  deployment  position  of  the  swarm  with  respect  to  the  beacon.  This 
J*  can  be  seen  most  easily  be  examining  the  results  for  the  fifteen-drono  swarm, 
In  which  the  ratio  of  the  standard  deviations  In  x  and  y  Is  closest  to  one.  This 
swarm  is  t,he  most  symmetric  with  regards  to  the  direction  to  the  goal,  as  seen 
in  2. 

Figure  3  shows  the  first  twenty  time  steps  for  a  swarm  of  fifteen  drones 
w  towards  a  goal  beacon  located  at  (75,75)  in.  Figure  3a  depicts  perfect  range 
and  pieition  measurements  and  figure  3L  depicts  an  uncertainty  of  LO  m  in 
range  a  ml  position  measurements,  simulated  by  gatissian  noise  centered  on  the 
actual  position  and  with  a  =  1.0  rn. 


(a) 


(h) 


Figure  3:  Simulation  results  for  a  swarm  of  15  drones.  Figure  3a  has  zero 
uncertainty  in  range  and  position  measurements;  Figure  3b  has  uncertainty  in 
range  and  position  measurements  of  l.()  rn 


2-L  A  simple.  range- fimle. r  model 

u  Obtaining  a  measurement  of  range  from  a  given  drone  to  the  goal  beacon 
is  not  a  simple  problem,  particularly  if  a  system  designer  wisluw  to  avoid  a 
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transponder  for  the  task.  Most  range  finding  systems,  such  as  Distance  Mcasnr- 
iug  Equipment  (DME)  used  on  aircraft  require  a  mutual  exchange  of  information 
between  the  goal  beacon  and  the  aerial  vehicle. 

One  scenario  for  determining  distance  to  an  object  of  unknown  location  is 
to  consider  a  transmitter  of  known  power,  a  receiver,  and  a  solution  bused  on 
an  assumed  attenuation  model.  For  free  space  propagation,  wu  can  write  an 
equation  for  loss  as 

L(dB)  =  10 log  y  =  It)  Jog  (~jj)  (10) 

where  Pt  is  the  transmitted  power,  Pr  is  the  receiver  power.  /  is  the  frequency 
of  the  transmitted  signal,  c  is  the  speed  of  light,  and  d  is  the  distance  between 
the  receiver  and  transmitter. 

An  alternative  expression,  one  that  include  the  effects  of  scattering  and 
other  attenuation,  is  given  as 

L  (lift)  =  1  (J  log  ~  =  4t)  4-  lOn  log  d  +  l„iivr  (U) 

wlwrre  disa  term  that  captures  scattering  effects,  Ltt,lltrr  captures  other  losses 
In  the  path,  d  is  measured  in  km,  and  the  frequency  is  assumed  to  be  2.45  GHz. 

The  values  for  n  and  Lath,. r  are  scenario  dependent  [5],  For  typical  scenarios, 
tin:  scattering  coefficient  u  can  range  from  2  (representing  free  space  propaga¬ 
tion)  to  4  (representing  a  heavily  wooded  area),  and  L„tivT  can  range  from  U 
(free  space)  to  30  (heavily  wooded  area).  Using  these  assumptions  about  scat¬ 
tering,  attenuation,  anil  transmitted  power,  a  receiver  can  find  a  distance  by 
measuring  received  power. 

It  should  he  noted  that  1  am  not  making  any  claims  on  the  practicality  of 
implementing  the  above  model  for  range  determination.  It  is  my  goal  to  sliow 
that  the  approach  discussed  in  the  previous  auctions  is  robust  enough  to  handle 
incomplete  or  inaccurate  range  calculations  using  this  generalized  model. 
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3.  Simulations  and  Results 
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Ftgurft  4:  Simulation  results  for  a.  swarm  of  15  drones,  flange  to  the  beacon  is 
determined  based  on  assumptions  in  signal  attenuation,  Figure  4a  shows  tlie 
correct  assumption  for  both  attenuation  and  scattering;  Figure  4b  assumes  free 
space  propagation  when  scattering  and  attenuation  are  actually  through  lightly 
wooded  areas;  Figure  4c  assumes  free  spam  propagation  when  scattering  and 
attenuation  are  actually  through  heavily  wooded  areas. 


The  progression  of  a  fifteen-drone  swarm  was  calculated  for  several  scenarios 
in  which  tile  wrong  assumptions  were  made  by  the  autonomous  vehicles,  e  g. 
the  vehicles  assumed  a  free  strata:  propagation  instead  of  a  heavily  wooded  urea. 
it*  The  results  arc  shown  in  figure  4- 

In  each  case,  the  swarms  couvcrgisl  on  the  beacon.  As  L^Ai;r,  the  constant 
loss  term,  increased,  tin:  swarm  showed  signs  of  dispersing  as  it  approached  the 
goal.  The  important  observation,  however,  Ls  the  swarm  still  converged.  Thu 
dispersion  is  understandable,  as  the  constant  loss  term  will  cause  the  swarm  to 
tw  think  the  beacon  Is  farther  away  than  it  actually  is,  even  wlwn  the  swarm  lias 
reached  the  goal 

3-1.  Discussion 

The  work  in  the  previous  sections  shows  the  robustness  of  the  algorithm, 
but  many  technical  issues  liave  not  been  directly  addressed, 

i7*  Integmtion  of  sensor  doijt.  With  tile  assumption  of  a  GPS-deuied  environment* 
position  (as  wdt  as  pose)  is  determined  tlirougli  Inflation  of  commands  and 
augmented  by  data  from  on-boa rd  sensors  such  as  accelerometers  and  gyn>- 
scopis,  IF  not  executed  well,  this  approach  cun  quickly  load  to  unacceptable 
at)d  increasing  errors  Lej  position.  More  advanced  bichnltpics,  siidi  as  using  on- 
m  board  cameras,  are  addressed  in  other  works  [4]  [3]  and  will  not  be  discussed 
here.  T  have  assumed  that  the  drone  is  capable  of  maintaining  positional  data 
with  the  accuracy  stated  for  each  simulation. 

Minimui  spacing.  The  algorithm  J  described  included  no  mechanism  for  ensur¬ 
ing  the  swarm  does  not  converge  to  a  single  point.  That  safeguard,  as  witli  all 
mi  other  details  of  autonomous  navigation,  were  assumed  to  be  a  part  of  a  base¬ 
line  control  algorithm.  A  constrained  least  squares  approach  was  considered  for 
handling  issues  sudi  as  spacing,  but  was  rejected  to  miiiiiiihe  complexity  In  the 
algorithm. 
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4.  Conclusion 


The  algorithm  presented  in  this  paper  demonstrates  jus  important  capability 
available  though  the  use  of  multiple,  autonomous  drones:  the  ability  to  use 
multiple  entities,  each  possessing  limited  data,  to  solve  a  complex  problem 
Though  this  approach  was  conceived  with  cjuadrotom  in  mind,  it  certainly  can 
be  expanded  to  other  autonomous  vehicles  and  problems. 
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